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POSTURE ANGLE g bs, AND ARM POSTURES ON THE BASIS OF NORMAL TURNING GAIT PARAMETER. 
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ANGULAR VELOCITY, AND BODY INCLINATION RESTORING MOMENT ZMP-CONVERTED VALUE PEAK VALUE 
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(Zs,Vzs) AS INITIAL STATES OF BODY. 
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BOUNDARY CONDITION ERRORS (errx, errv, err e , err co ) 
= (Xs, Vxs, 9 bs, wbs)-(Xe, Vxe, ebe, cube) 



S212 



S214 yes / - . — . 

ARE ALL errx, errv, err e b, AND err cob / C REPETITION LOOPT) 



WITHIN PERMISSIBLE RANGES? 



DETERMINE A PLURALITY OF CANDIDATES (Xs+ A Xs, Vxs, cobs, ZMPrecpeek), 

(Xs, Vxs+ a Vxs, cobs, ZMPrecpeek), (Xs, Vxs, cobs+ a cobs, ZMPrecpeek), 
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SUCH THAT -Merr_p(k) IS PRODUCED ABOUT DESIRED ZMP. DETERMINE, HOWEVER, 
BODY HORIZONTAL ACCELERATION AND BODY POSTURE ANGULAR ACCELERATION SUCH THAT 
VALUE OBTAINED BY ADDING Ferr_p(k) TO TRANSLATIONAL FLOOR REACTION FORCE 
HORIZONTAL COMPONENT Fx DOES NOT EXCEED [Fxmin, Fxmax] AND THAT BODY POSTURE 
ANGULAR ACCELERATION BASED ON ZMPrec PATTERN IS PRODUCED DURING BODY 
INCLINATION ANGLE RESTORING PERIOD. 



NTEGRATE BODY HORIZONTAL ACCELERATION AND BODY POSTURE ANGULAR ACCELERATION 
TO CALCULATE BODY HORIZONTAL VELOCITY AND BODY POSTURE ANGULAR VELOCITY. 
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ZMP AND TRANSLATIONAL FLOOR REACTION FORCE HORIZONTAL COMPONENT Fsinpl(k) AT TIME k, 
WHICH ARE GENERATED ON SIMPLIFIED MODEL BY DETERMINED DESIRED MOTION. 



CALCULATE FLOOR REACTION FORCE MOMENT HORIZONTAL COMPONENT Msemifull(k) ABOUT 
DESIRED ZMP AND TRANSLATIONAL FLOOR REACTION FORCE HORIZONTAL COMPONENT Fsemifull(k) 
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a = artmp+ (Fx'-Fxtmp') /AFp 
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PARAMETER OF CURRENT TIME GAIT. 
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DETERMINE FLOOR REACTION FORCE VERTICAL COMPONENT 
TRAJECTORY PARAMETER OF CURRENT TIME GAIT. 
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PROVISIONALLY DETERMINE ZMP CORRECTION PARAMETER CANDIDATE a AND BODY INCLINATION 
RESTORING MOMENT ZMP-CONVERTED VALUE PEAK VALUE CANDIDATES (ZMPrecpeeka, ZMPrecpeekb). 
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CALCULATE PROVISIONAL CURRENT TIME GAIT UNTIL TERMINATING TIME ON THE BASIS OF PARAMETER 
OBTAINED BY CORRECTING ZMP PARAMETER, WHICH HAS BEEN PROVISIONALLY DETERMINED BY 
PROVISIONAL DETERMINATION PROCESSING OF CURRENT TIME GAIT PARAMETER, BY ZMP CORRECTION 
PARAMETER CANDIDATE a, BODY INCLINATION RESTORING MOMENT ZMP-CONVERTED VALUE 
PEAK VALUE CANDIDATES (ZMPrecpeeka, ZMPrecpeekb), AND OTHER CURRENT TIME GAIT PARAMETERS. 



DETERMINE TERMINAL DIVERGENCE COMPONENT qO[k] ACCORDING TO THE FOLLOWING 
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